/***************************************************
 @Name :        小铭同学
 @Time :        2022-10-30
 @Email :       LiaoMingWJ233@163.com
 @Comment :     超声波测距功能实现
 @FileName :    ultrasonic.c
 @Version :     1.0
****************************************************/

 
#include "ultrasonic.h"

#include "peripheral.h"

int ultrasonic_distance(void)
{
  int dis = 0;
  
  TRIG(GPIO_PIN_SET);
  
  while( ECHO == 0 );   /* 等待echo为1 */
  
  TRIG(GPIO_PIN_RESET);
  
  timer6_start_count();
  
  while (ECHO == 1);    /* 等待echo为0 */
  
  dis = timer6_stop_count();  /* 获得时间 */
    
  dis = dis*0.17; /* 单位mm */
  
  if (dis<30) /* 小于3cm */
    dis = 0;
  
  return dis;
}



void ultrasonic_test(void)
{
  while(1)
  {
    printf("%d\n",ultrasonic_distance());
    delay_ms(500);    
  }
}



